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(57)Abstract: 



(a) 




PURPOSE: To generate the track of the robot in 
three-dimensional environment wherein undulations of hills, 
differences in level, a pond, etc., are present and also generate a 
track corresponding to the difference in the moving ability of the 
robot. 

CONSTITUTION: The track of the moving robot is generated in 
five stages of procedures. The spatial information distribution of 
an original map 1 1 having topology and obstacles is inputted to 
the robot first. Then a robot map 21 showing whether or not the 
robot can move to respective points is generated from the original 
map 1 1 by a function with which the possibility of movement 
viewed from the robot can be judged. The robot map 21 is 
properly emphasized to generate an immobility distribution 
figure 31 from which the easiness of the movement of the robot 
and the degree of danger can be judged. Then the slope of the 
immobility distribution figure 31 and attractive force generated at 
a target point B are put together at respective points to generate a 
potential force figure 41 In the potential force figure 41 , a curve is drawn from an immobile area 43 to the 
target point B along a potential force 42 and regarded as a track 51 . 
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[Drawing 51 




DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Industrial Application] This invention relates to a mobile robot's orbital generation method 
[0002] 

[Description of the Prior Art] When generating a mobile robot's orbit conventionally, as shown in drawin- 5 

and drawing 6 , regardless of a robot's capacity, a suitable numeric value (potential) is artificially set as the" 

existence region of an obstruction 2 in the two-dimensional plane region 1, and the orbit 3 from the start 

point A to the target point B is searched for using Laplace's equation based on this. In addition, when as for 

draWmg5 ' tWO ° r more P laces dotted w ith the obstruction 2, drawing 6 shows an example in case an 
obstruction 2 is a wall. 

[0003] The object domain of trajectory generation is restricted to the two-dimensional flat surface like the 
two-dimensional plane region 1. and this approach is not taking into consideration three-dimension-fields 
such as boom hoisting of the crest in an outdoor environment. Moreover, if human being performs decision 
whether a robot is movable and it is judged to an obstruction 2 that migration is impossible, the suitable 
BMoST ValUC W ° Uld be defmed artifkially k WiU be Set as the existence re g ion ^ an obstruction 2. 
[Problem(s) to be Solved by the Invention] The trajectory generation in a three-dimension-environment 
(existing environments, such as a crest, a slope, a cliff, a level difference, a pond, and a river) which is 
represented with the above-mentioned conventional orbital generation method on the outdoors is impossible 
Moreover, fixed potential was artificially set as the part of an obstruction, and since how to make an orbit on 
which a robot advances in the direction where potential is low was adopted, the orbit had the fault by which 
the same thing is generated to all robots regardless of a robot's capacity, and the orbit into which the high 
robot of migration capacity bypasses an obstruction greatly specially is generated. 

[0005] This invention was made in view of the above-mentioned actual condition, and it aims at offering the 
orbital generation method of the mobile robot which can perform trajectory generation according to the 
difference ,n the migration capacity resulting from a robot's migration format while it can perform a robot's 
trajectory generation in the three-dimension-environment which exists [ pond / boom hoisting of a crest and 
a slant face, / a level difference, a pond ]. 
[0006] 

[Means for Solving the Problem] The orbital generation method of the mobile robot concerning this 
invention The 1st step which inputs the space information distribution with the geographical feature of the 
Hara map, and an obstruction into a robot, The 2nd step which generates the robot map showing the 
propriety of migration of an every place point from the function which sees from a robot based on the 
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information on the above-mentioned Hara map, and can judge the possibility of migration, The 3rd step 
which generates the improper mobility distribution which emphasizes the above-mentioned robot map proper 
and can judge danger in the ease of carrying out of migration of a robot, The 4th step which compounds the 
suction force which the improper mobility information inclination and target point in the above-mentioned 
improper mobility distribution were made to generate at an every place point, and generates a potential force, 
A curve is drawn in accordance with the potential force which goes to the above-mentioned target point from 
a start point, and it is characterized by providing the 5th step which makes this an orbit 
[0007] 
[Function] 

(1) The 1st step (input of the Hara map) 

The Hara map is the information which human being gives to a robot, is a map of the form which human 
being can understand, and has the attribute information Attr (xi and yi) which describes of what kind of 
property the height information h (xi and yi) in the point (xi and yi) of arbitration and its location are things. 
The information on a start point and a target point is also put in into attribute information. 
[0008] (2) The 2nd step (generation of a robot map) 

Conversion for human being's view of the world (form which a robot can understand) of a robot from a view 
of the world (form which human being can understand) is performed, information required for migration of a 
robot is extracted, and a robot map is generated. 
[0009] (3) The 3rd step (generation of improper mobility distribution) 

Although information required for migration of a robot was extracted in the phase of the above-mentioned 
robot map generation, evaluation of whether this is what it is hard to move how much to the capacity which a 
robot has is not made. 

[0010] Therefore, on the basis of each robot's capacity, this step evaluates whether it is what how many 
extracted information cannot move easily, evaluates and generates improper mobility distribution The 
numeric value which shows the difficulty of carrying out of migration of a robot is improper mobility. 
[00 1 1 ] (4) The 4th step (generation of a potential force) 

By calculating to the numerical distribution set up by the above-mentioned improper mobility distribution 
the flow field from a migration improper field to a target point, i.e., a potential force, is generated 
[00 1 2] (5) The 5th step (orbital generation) 

The flow field generated in the above-mentioned potential force generation processing is followed in 
accordance with the flow from the start point, and the path in which it results [ from a start point ] to a target 
point, i.e., a robot's orbit, is generated by connecting the locus with a line. 

[0013] The above (1) The orbit according to the difference in the migration capacity which can generate a 
robot's orbit in the three-dimension-environment which exists [ pond / boom hoisting of a crest, a slant face, 
etc., / a level difference, a pond ], and originates in a robot's migration format with the procedure of - (5) is ' 
generable. 
[0014] 

[Example] Hereafter, one example of this invention is explained with reference to a drawing. The orbital 
generation method of the mobile robot concerning this invention consists of five steps of trajectory 
generation procedures shown in following (1) - (5), and performs trajectory generation using processing units 
such as CPU. 

[0015] (1) Input the space information distribution (Hara map) with geographical feature and an obstruction 
into the input robot of the Hara map. 

(2) Make the space information distribution map (robot map) showing the propriety of migration of an every 
place point from the function which sees from a robot and can judge the possibility of migration from the 
generation Hara map of a robot map. 

[0016] (3) Emphasize the generation robot map of an improper mobility distribution map proper, and 
generate the space information distribution map (improper mobility distribution map) which can judge 



- 5 - JP08-22324 
danger in the ease of carrying out of migration of a robot. 

[0017] (4) Compound the suction force which the inclination and target point of a generation improper 
mobility distribution map of a potential force Fig. were made to generate at an every place point and 
generate a potential force Fig. 

[001 8] (5) A curve is drawn in accordance with the potential force which goes to a target point from a 
trajectory generation start point, and let this be an orbit. 

[0019] Hereafter, the detail of the five steps of above-mentioned trajectory generation procedures is 
explained with reference to drawing 1 . Drawing 1 (a) - (e) supports the trajectory generation procedure of 
above-mentioned (1) - (5). 

(1) ON ** of the Hara map - this Hara map is map information which human being gives to a robot and is a 
map of the form which human being can understand. This map information has two information shown 
below. 

[0020] (a) Geographical feature height information zi =h to the two-dimensional plane coordinates (xi and 
yi) shown in drawing 2 (a) (xi and yi) 

(b) Attribute information Attr which shows of what kind of property the location shown with the 
above-mentioned coordinate (xi and yi) is a thing (a crest (xi and yi), a slope, a level difference, a river a 
pond, a slot, a cliff, a desert, common, a start point, a target point, etc. are included) 
The above-mentioned attribute information is an attribute [ in / on / in / as shown in drawing 2 (b) / an 
outdoor environment / a crest, a pond, a penetration prohibited area, a dangerous-substance 
laying-under-the-ground area, a desert (sands) and an inside-of-a-house environment, and / the location (xi 
and yi) of a stairway, a wall, an off-limits area, etc. ] [0021]. 
[Equation 1] 

Attr Cx i, y i) e a 1. a 2, », a n 

Physical / un-physical information on the location is expressed in the form to say. Moreover, the information 
on the above (a) and (b) is expressed as follows as a vector 
[0022] 
[Equation 2] 



y ( .i. ynJ hUi - "> 1 _.<„ 

[Attr (x i, y i) J 



[0023] DrawingJ. (a) is what showed the Hara map 1 1, and two crests 12 and ponds 13 exist between the 

start point A and the target (gall) point B including two crests (slope land) 12, a pond 13, and a level 

difference 14 as attribute information. 

[0024] Above-mentioned crest 12 x (xi and yi) 

= hexp {- (xi-x0) (2+(yl-y0) 2) / d2} - (2) 

** - the width of face d of center position (xO and yO) and height [ of a crest ] h and the foot of a crest is set 
up like. 

[0025] (2) Perform conversion for robot map human being's view of the world (form which a robot can 
understand) of a robot from a view of the world (form which human being can understand), and extract map 
information required for migration of a robot. That is, the function f for view-of-the-world conversion is 
made to act to the information in the above-mentioned Hara map 11 , as shown in a degree type, and the robot 
map vector Rm (xi and yi) is generated. 
[0026] 

Rm(xi and yi) =f (M (xi and yi)) - (3) 

The robot map 21 which this shows to drawing 1 (b) is generated. In this robot map 21, 22 is the skew-ratio 
information on the slant face in a crest 12. A wheel mold, a crawler mold, and a foot type are considered as a 



- 0 - JP08-22324 
robot's migration format here. In each migration format, information required for migration is shown below. 
[0027] (a) The height of the level difference and slot which a wheel robot wheel can overcome serves as a 
wheel radius at the maximum. Moreover, when reaching a slant face, gravity must be opposed, and a 
limitation is in the skew ratio which can carry out a climb. Therefore, when considering a wheel robot's 
migration capacity, the skew-ratio information 22 in the slant face of a crest 12 and the information over a 
level difference 14 are required. Therefore, the attribute of the skew ratio shown by the following (4) 
formulas, the level difference shown by (5) formulas, and the geographical feature shown by (6) formulas is 
memorized as information. 
[0028] 
[Equation 3] 
_ 8 Z (r) 

p — JT~ - "> 

H-Hstep (r) ... ( 5) 

Attr (d € mm. m. m. mamsl •••} ••• (6> 

[0029] However, geographical-feature height H in inclination vector Z(r):r of a location Prslant face of the 
arbitration on rrmap: Level difference height Hstep (r) : The function Attr which returns the level-difference 
height in the location r of arbitration (r): It is the attribute information on the geographical feature in the 
location r of arbitration. 

[0030] (b) While a crawler robot crawler robot graduates the irregularity of the ground by the crawler in 
order to run, concavo-convex small information and level difference information are not related It is defined 
with the configuration of a crawler, a rake angle, a pitch, etc. whether it can get over to the irregularity of 
how much and a level difference. Here, in order to clarify a difference with other robots, a level difference is 
assumed to be what can be overcome and considers only the skew-ratio information 22. Therefore let the 
attribute of the skew ratio shown by the above-mentioned (4) formula, and the geographical feature shown 
by (6) formulas be the information on the robot map 21. 

[0031] (c) The skew-ratio range which does not reverse a foot robot foot robot with the movable skew-ratio 
range by constraint of the movable range of a foot, either is specified. Therefore, since the skew-ratio 
information 22 serves as an important index, let the attribute of the skew ratio shown by the 
above-mentioned (4) formula, and the geographical feature shown by (6) formulas be the information on the 
robot map 21. 

[0032] In addition, tilt angle theta of the slant face of the inclination vector P of a slant face to the location 
Theta=tan -1 (IIPII) - (7) 
It comes out and asks. 

[0033] (3) Emphasize the information on the generation above-mentioned robot map 21 of an improper 
mobility distribution map according to each robot's capacity, and generate the improper mobility distribution 
map 31 shown in drawing 1 (c). That is, to the above-mentioned crest 12, the level difference improper 
mobility 34 is shown to the attribute improper mobility 33 and a level difference 14 to the skew-ratio 
improper mobility 32 and a pond 13. The above-mentioned improper mobility distribution map 31 is a kind 
of potential, and the magnitude means the difficulty of carrying out of migration of a robot. That is it means 
that a robot cannot go there easily, so that improper mobility is large. As for each robot, the maximum climb 
skew ratio is prescribed by the capacity. The tilt angle for which it asked with the robot map 21 sets infinity 
to the field exceeding a robot's maximum climb angle, and the field which must not be come into using 
attribute information. Hereafter, a setup of the improper mobility according to a robot s migration format is 
explained. 

[0034] (a) The propriety of the migration of a wheel robot in improper mobility 34 level difference by the 
wheel robot i. level difference is decided by whether the height of a level difference 14 is large compared 
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with the radius of a wheel, or small. That is, possible level difference threshold Hmax to overcome What is 
necessary is just to make it binary. It is Ustep about the level difference improper mobility 34. If it carries 
out, it will carry out like a degree type and will be made binary 
[0035] 
[Equation 4] 



Ustep" 



<», for H>Hnax 
0. for H<Hoax 



(8) 



[0036] The tilt angle theta of the improper mobility 32 robot map 21 by ii. skew ratio is emphasized. The tilt 
angle theta is maximum climb angle thetamax. Improper mobility becomes large, so that it approaches, and it 
is theta>-theta max. The following formulas are used so that it may become infinite, the skew-ratio improper 
mobility 32 - Uslope ** - if it carries out Uslope =tan { (90 degrees / thetamax) -theta} - (9) 
It becomes. 

[0037] Since a robot must not go there, as for the case of a pond or a penetration keepout area etc., the 
attribute data of the improper mobility 33 robot map 21 by the iii. attribute sets up the value of infinity. If 
attribute improper mobility 33 is set to Uattr, it will set up like a degree type 
[0038] 
[Equation 5] 

Uattr -J"' for Attr * normal 

[0, for Attr = normal 11 U) 

[0039] And the above (i) (ii) (iii), Each improper mobility Ustep Uslope and Uattr are superimposed like a 
degree type and the improper mobility distribution map 3 1 is generated. 
U=Ustep+Uslope+Uattr -(11) 

(b) By the crawler robot in the example of crawler robot **, since the level difference is assumed to be what 
can be overcome as described above, generate the improper mobility distribution map 31 from the skew-ratio 
improper mobility (Uslope) 32 and the attribute improper mobility (Uattr) 33 

[0040] 

U=Uslope+Uattr - (12) 

(c) Set up the foot robot skew-ratio improper mobility (Uslope) 32 as follows 
[0041] 

[Equation 6] 

Uslope — t a n (K • 0) — (1 3) 

|"0, for 6<0. 75 • tfmax 



<9nax 



for 6 >0. 7 5 • 0nax 



[0042] The improper mobility distribution map 31 is generated as well as a crawler robot from the skew-ratio 
improper mobility (Uslope) 32 and the attribute improper mobility (Uattr) 33. For the active suspension 
capacity which a foot has, a foot robot can move like the flat ground, when a skew ratio is not tight Here 
temporarily, the same migration as the flat ground can be performed, and after it, 75% of the maximum ' 
climb inclination is performing the same potential setup as a crawler and a wheel robot noting that a walk 
becomes difficult gradually. The rest generates the improper mobility distribution map 31 from the 
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skew-ratio improper mobility 32 and the attribute improper mobility 33 like a crawler robot. 
[0043] (4) potential force generation - here, as shown in drawing 1 (d), generate potential force drawing 41 
m quest of the potential force 42. In this drawing, 43 shows the migration improper field corresponding to 
the above-mentioned skew-ratio improper mobility 32 and the attribute improper mobility 33. 
[0044] The above-mentioned potential force 42 is like the flow of the force of tending toward a target As 
potential for that, the solution (it is henceforth called the Laplace potential) of Laplace's differential equation 
is used. This potential is widely known as a solution of a diffusion equation or a heat conduction equation 
and the numerical calculation algorithm is also studied well. It is mentioned that potential does not take 
extremal value as a description of the Laplace potential in the field with which are satisfied of a Laplace 
equation. If heat conduction is considered for an example, at the point without ** and an endoergic point 
heat is flowing in the direction of an algorithm, without stopping at one point. Therefore, if the migration 
direction of heat is followed, it will surely follow and stick to an endoergic point. 

[0045] If it thinks with the application of this to this invention, the source of generation of heat will be the 
migration improper field 43, and a heat sink will serve as the target point B. This is called the potential force 
42 by the reason that flow which does not have the minimal value toward the target point B is made from the 
migration improper field 43. It is very convenient that there is no minimal value, and it guarantees surely 
reaching the target point B, without an orbit ****ing by somewhere. The procedure of acquiring the potential 
force 42 is shown below. 

[0046] (a) In the improper mobility distribution map 31 shown in binary-ized above-mentioned drawing 1 (c) 
the field of infinity is the migration improper field 43 which a robot cannot come into, and the set-up value is ' 
the movable field 44, although the difference of extent has the remaining part. Thus, it divides into two fields 
of the 44/migration improper field 43 of movable fields. 

(b) It is application Laplace's differential equation [0047] about Laplace's differential equation 
[Equation 7] 



3 3> 3 Q . 9 0> 

tztiL* <D = <D (x A , x 2 , — , 



~r ) 

- (1 5) 



In the lattice points i and j, it is the calculated value of the potential acquired by n-th repetition count The 
first boundary condition gives negative value phigoal to the migration improper field 43 at the forward value 
phi 0 and the target point B. Moreover, it is phi 0 also to the movable field 44 as initial condition of 
repetition count. It gives. At first, the target point B is low and starts all other fields from the same height 
And the potential of the low level (low level) of the target point B spreads in all the corners of a field by ' 
repeating equalization actuation of the above-mentioned (15) formula at all the points of the movable field 
44. And count is ended in the place where the flow emitted from the migration improper field 43 and the 
flow absorbed at the target point B were balancing mostly. 

[0048] (c) Search for a potential field gradient in each lattice point which searches for the potential field 
gradient of each lattice point. The inclination of potential is [0049] when f is made into the potential force 42 
[Equation 8] 
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9<t> 
9 r 



It comes out and asks. 

[0050] (5) Draw a curve in accordance with the potential force 42 which goes to the target point B obtained 

in trajectory generation each lattice point, and generate the orbit 51 shown in drawing 1 (e). The lattice point 

in two-dimensional space as shown in drawing 3 (i, j), (i+1, j), potential force fs i (x y) of the point (x y) in 

the field surrounded by (i, j+l), and (i+1, j+1), and j fs i (x y) and j = - fi and j (i(i+l-x)+l- v ) 

+fi+l,j (x-i)(j+l-y 

+fi,j+l (i+l-x)(y-j 

+ fi+l and j+l (y-j (x-i)) - (17) 

It comes out and asks. 

[0051] Here, i and j are the coordinate of the point nearest to a zero, and fi and j among the four lattice points 
of a positive grid field including a point (x y). It is the potential force acquired by processing of potential 
force generation of the above (4). 

[0052] And if the potential force of Point S can be found as shown in drawing 4 , an orbit will be advanced 
until it runs against a gridline. How to search for the point Pnext of having run against this gridline is 
explained below. 

[0053] It is the position vector of the above-mentioned point S and the lattice point of the surroundings 
containing it PS, PI , P2, P3, and P4 If it carries out PS+tfS =( 1 -s) Pi+sPi+ 1 - (1 8) 
It becomes. Here, it is fS. Pi-Pi+1 It is [0054] if the 1st order is independent. 
[Equation 9] 



[:]- 



[fs Pi -Pi+1 ] -1 [Pi -p s j 

- (1 9) 



It becomes. Moreover, if t>=0 and 0>=s>= 1 are filled at the time of i= 1 , the point of Pnext can be found 
from Pnext-tfS+PS. If conditions are not fulfilled, it carries out by i= 2, and 3 and 4. P5 =P1 [ however 1 it 
is . 

[0055] The orbit 51 of the robot from the start point A to [ bypasses an obstruction as mentioned above and ] 
the target point B is generable. In this case, the orbit 51 with few detours is generated as a wheel mold -> 
crawler mold -> foot type and a robot's migration capacity become high 
[0056] 

[Effect of the Invention] As a full account was given above, while being able to perform a robot's trajectory 
generation in existmg three-dimension-environments, such as boom hoisting of a crest and a slant face and a 
level difference, a pond, according to this invention, trajectory generation according to the difference in the 
migration capacity resulting from a robot's migration format can be performed. 



DESCRIPTION OF DRAWINGS 
[Brief Description of the Drawings] 

[Drawin gjj Drawing showing the orbital generation method of the mobile robot concerning one example of 
this invention. 

[ Drawing 2 ] The conceptual diagram of a trajectory generation lot Fig. in this example. 
[Drnwin-jy The explanatory view for searching for the potential force within the lattice point in this 
example. 
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[Drawing 4] The explanatory view for searching for the next point of the orbit in this example. 
[Drawing 5] Drawing showing the orbital generation method of the mobile robot in the conventional 
two-dimensional flat surface. 

[Drawing 6] Drawing showing the orbital generation method of the mobile robot in a two-dimensional flat 
surface with the conventional wall. 
[Description of Notations] 

11 Hara Map 

12 Crest 12 

13 Pond 

14 Level Difference 

21 Robot Map 

22 Skew-Ratio Information 

3 1 Improper Mobility Distribution Map 

32 Skew-Ratio Improper Mobility 

33 Attribute Improper Mobility 

34 Level Difference Improper Mobility 

41 Potential Force Fig. 

42 Potential Force 

43 Migration Improper Field 

44 Movable Field 
51 Orbit 



[Claim(s)] 

[Claim 1] The 1st step which inputs the space information distribution with the geographical feature of the 
Hara map, and an obstruction into a robot, The 2nd step which generates the robot map showing the 
propriety of migration of an every place point from the function which sees from a robot based on the 
information on the above-mentioned Hara map, and can judge the possibility of migration, The 3rd step 
which generates the improper mobility distribution which emphasizes the above-mentioned robot map proper 
and can judge danger in the ease of carrying out of migration of a robot, The 4th step which compounds the 
suction force which the improper mobility information inclination and target point in the above-mentioned 
improper mobility distribution were made to generate at an every place point, and generates a potential force 
The orbital generation method of the mobile robot characterized by providing the 5th step which draws a 
curve in accordance with the potential force which goes to the above-mentioned target point from a start 
point, and makes this an orbit. 

[Claim 2] The orbital generation method of the mobile robot according to claim 1 characterized by 
computing the potential force in the 4th step of the above using the solution of Laplace's differential equation 
based on the improper mobility information in the above-mentioned improper mobility distribution 



WRITTEN AMENDMENT 

[a procedure revision] 

[Filing Date] August 17, Heisei 6 
[Procedure amendment 1] 
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[Document to be Amended] Specification 
[Item(s) to be Amended] 0024 
[Method of Amendment] Modification 
[Proposed Amendment] 
[0024] The above-mentioned crest 12, 
x(xi ,yi ) 

= hexp {- (xi-xO) (2+(yi-y0) 2) / d2} - (2) 

** - the width of face d of center position (xO and yO) and height [ of a crest ] h and the foot of a crest is set 
up like. 

[Procedure amendment 2] 
[Document to be Amended] Specification 
[Item(s) to be Amended] 0032 
[Method of Amendment] Modification 
[Proposed Amendment] 

[0032] In addition, the tilt angle theta of the slant face of the inclination vector P of a slant face to the 
location 

Theta=tan -1 (IIPII) - (7) 

It comes out and asks. 

[Procedure amendment 3] 

[Document to be Amended] Specification 

[Item(s) to be Amended] 0044 

[Method of Amendment] Modification 

[Proposed Amendment] 

[0044] The above-mentioned potential force 42 is like the flow of the force of tending toward a target. As 
potential for that, the solution (it is henceforth called the Laplace potential) of Laplace's differential equation 
is used. This potential is widely known as a solution of a diffusion equation or a heat conduction equation, 
and the numerical calculation algorithm is also studied well. It is mentioned that potential does not take 
extremal value as a description of the Laplace potential in the field with which are satisfied of a Laplace 
equation. If heat conduction is considered for an example, heat is flowing at the point without ** and an 
endoergic point, without stopping at one point. Therefore, if the migration direction of heat is followed, it 
will surely follow and stick to an endoergic point. 
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